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Adaptive inertia! vehicle navigation system. 

Vehicle navigation system provided with an adaptive 
inertia! vehicle navigation system based on the measure- 
ment of the speed and the lateral acceleration of the vehicle 
and provided with a correction unit for correcting the 
measured values. 

Navigation system for a road vehicle, comprising inter 
aha a route-determining unit and position-locating means. 
The route-determining unit works together with a mass 
memory in which geographic data of a road network are 
stored. The route-determining unit determines a driving 
route between a starting point and a destination which are 
communicated by the driver to the vehicle. The position- 
locating devices determine the vehicle position coordinates 
recurrently from the speed and acceleration of the vehicle in 
motion as determined by a measuring unit. The navigation 
system is further provided with a correction unit which 
determines a correction vector for correcting the generated 
vehicle position coordinates. This correction vector is deter- 
mined by performing a transposition of the generated 
vehicle position coordinates to an actual road position as 
repeated by coordinates of the road network which are 
Stored in the mass memory. Also derived from the measured 
speed and lateral acceleration and also from the generated 
vehicle position coordinates is an acceleration operator, 
which acceleration operator operates on the correction 



vector in order to derive from this a correction value for the 
measured acceleration. The navigation system further com- 
prises a receiver for receiving position coordinate signals 
ongmatrng from a navigation satellite. A Kalman filter mixes 
the vehicle position coordinates with the position coordin- 
ates originating from the navigation satellite. 
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"Vehicle navigation system provided with an adaptive 
inertial navigation system based on the measurement of the 
speed and lateral acceleration of the vehicle and provided 
with a correction unit for correcting the measured values". 

The invention relates to a navigation system for a 
road vehicle, comprising a measuring unit which has a 
speedometer and which is linked with a central unit, a 
communication unit connected to the constant unit for the 
$ input of a starting position and a destination and for the 
display of a driving route between starting position and 
destination, which central unit contains a mass storage 
device for storing geographic data of a road network, a 
control unit and position-locating devices which are all 
W connected with a common communication line, which control 
unit contains a route-determining unit for determining a 
driving route between the starting position and the 
destination by making use of the geographic data from the 
backing store, which position-locating devices have a first 
15 input which is connected with an output of the measuring 

unit for receiving measurement data and are provided in or- 
der to determine from the measurement data, after receiving 
the starting position, successive vehicle position coordi- 
nates and the driving direction of the vehicle in motion. 
2D a navigation system of this kind is known from 

the article "Elektronischer Wegweiser, Ein Navigations- 
system fur St&dte" published in the Journal Funkschau 23, 
1983, pages h8 - 50. The navigation system therein described 
contains a backing store in which the geographic data of a 
road network, for example that of a town, are' stored. By 
means of a communication unit which contains for example 
a keyboard, the driver of the vehicle makes his starting 
position and his destination known to the navigation system. 
Under control of the control unit and by making use of geo- 
graphic data of the road network, the route-determining unit 
determines a driving route which indicates the way to he 
followed between starting position and destination* The 
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position-locating devices receive from the measuring unit 
the speed of the vehicle measured by the speedometer and 
the speeds of revolution of both rear wheels measured by 
wheel sensors. The position-locating device determine there- 
5 from the vehicle position coordinates and the driving di- 
rection from the difference in the speeds of revolution of 
the rear wheels. By comparison of the vehicle position 
coordinates with the geographic data that pertain to the 
driving route, the progression of the vehicle along the 
10 driving route can be followed and the correct navigational 
instructions can be communicated to the driver via the 
communication unit. 

A disadvantage of the known navigation system is that 
the determination of the vehicle position coordinates and 
15 the driving direction is realised by measurements done with 
the aid of sensors which are fixed to both rear wheels of 
the vehicle. The determination of the driving direction 
from the difference in speed of revolution of the rear wheels 
is inaccurate because it is dependent on too many factors 
20 such as for example wheel spin and unequal type pressure, 
which factors are mutually incapable of correction. Another 
manner of determining the driving direction is to use a 
magnetic compass. However the bodywork of the vehicle and 
driving past objects that contain a large amount of iron, 
25 disorient the compass. 

An object of the present invention is to provide 
a navigation system whereby the position of the vehicle can 
be accurately determined with the position-locating device 
without the mentioned disadvantages occurring. 
30 A navigation-, system in accordance with the invent- 

ion is characterized in that the measuring unit contains 
an accelerometer for measuring the lateral acceleration of 
the vehicle and that the position-locating are provided 
in order to generate recurrently from the measured lateral 
35 acceleration and speed of the vehicle the successive 

vehicle position coordinates and the driving direction of 
the vehicle in motion. 
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An accelerometer is simple to implement and more- 
over correction of the measured signal can easily be 
determined since the measured acceleration signal is 
influenced by parameters that can be calculated. Further, 
the measurement of the lateral acceleration giv« s the 
advantage that it is relatively easy to determine there- 
from the driving direction. For of course the lateral 
acceleration is a yardstick of the change of direction of 
the vehicle . 

The use of an accelerometer for determining the 
lateral acceleration of the vehicle and deriving position 
coordinates therefrom is in itself known from the American 
patent no. 4,254,465. However, in the system therein 
described no use is made of a mass storage device and there 
is no route-determining unit. In a system in accordance 
with this American patent the vehicle position coordinates 
are not determined solely from the measured speed and 
lateral acceleration. 

The invention further relates to a navigation system 
which contains a correction unit connected to the communi- 
cation line for determining a correction vector that gives 
the deviation between the vehicle position coordinates gene- 
rated with position-locating devices and road position co- 
ordinates for a corresponding position on a part of the road 
which are originated from said mass storage device, and for 
correcting therewith the generated vehicle-position coordi- 
nates. 

The correction unit periodically compares the ve- 
hicle position coordinates with road position coordinates 
representing the geographic data along the driving route. 
As a result of all kinds of causes of error, such as for 
example inaccuracy of the speed signal and drift in the 
electronics, considerable deviations may sometimes arise 
between the position of the vehicle as determined by the 
position-locating devices and the real position of the 
vehicle on the road. The correction unit determines a 
correction vector which gives the deviation between the 
vehicle position coordinates and stored road position 
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.co-ordinates for a corresponding position on a part of the 
road which is derived from the geographic data. This correc- 
tion vector is then used for applying a correction to the 
vehicle position coordinates. 

A navigation system in accordance with the invention 
is further characterized in that the geographic data of 
the road network contain a set of segments whereby each 
segment represents from the road network a part of the road 
that is bounded by two nodal points and is identified at 
least by the coordinates of these two nodal points, and 
which correction unit is provided with transposition means 
for determining, under the control of a first correction 
signal generated by the control unit, for each segment from 
a group of segments situated within a given radius around 
a generated vehicle position coordinate, a transposition 
of the generated vehicle position coordinate to transposed 
position coordinates for a transposed vehicle position 
situated near the relevant segment, which transposition 
means are further provided for generating the correction 
vector that gives the distance between the calculated 
vehicle position and its transposed positions, which cor-- 
rection unit is further provided with selection means for 
selecting from these generated correction vectors that 
vector which has the smallest distance among the said 
distances that belong to the same group, which correction 
is made on the basis of the selected correction vector. 

The arranging of the geographic data relating to the 
road network in a set of segments and the assigning of 
coordinates to those segments makes it possible to compare 
the generated vehicle position coordinates with coordinates 
from those segments. This comparison is done by the trans- 
position means which transpose the generated vehicle 
position coordinates to coordinates pertaining to a group 
of segments situated near the generated vehicle position 
coordinates. For each segment from the group, a trans- 
position is determined and upon each transposition the 
distance between the generated vehicle position and the 
transposed vehicle position is determined* That distance 
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then gives a correction vector which indicates the cor- 
rection that must be applied to the generated vehicle posit- 
ion coordinates. In order to determine which of the segments 
of the said group the generated vehicle position coor- 
5 dinates belong, a selection must be made between the gene- 
rated correction vectors. This selection is done by the se- 
lection means, which select the correction vector with the 
smallest value. In this way a correction unit is realised 
with which, in a relatively simple manner and on the assumpt- 
10 ion that the vehicle is able to move only along the road, 

corrections can be applied to the generated vehicle position 
coordinates* Further, since the vehicle position coordinates 
are determined recurrently, use can be made of the corrected 
vehicle position coordinates when determining subsequent ve- 
15 hicle position coordinates, in such a way that cumulative 
error effects are eliminated. So a dead reckoning system is 
formed hereby. 

A first preferred embodiment of a vehicle navigat- 
ion system in accordance with the invention is characterized 
20 in that segments for parts of roads which run along a straight 
line form a first subset of the set of segments, and whereby 
the straight part of a road is represented by one section, 
and whereby the transposition means perform a transposition 
by determining the perpendicular projection of the generated 
25 vehicle position coordinate onto the section of the rele- 
vant segment, and declares the transposition as valid when 
the transposed position is a point of that section. 

A second preferred embodiment of a vehicle navigat- 
ion system in accordance with the invention is character- 
30 ized in that segments for parts of roads which follow a 
curved line form a second subset of the set of segments, 
the curved part of a road is divided into a number of 
sections, whereby the transposition means perform a trans- 
position by determining the perpendicular projection of the 
generated vehicle position coordinate onto at least one 
section from the said number of sections and declares the 
transposition to be valid when the transported position is 
a point of one of the sections. 



10 



01 81012 

PHN 11.122 -6- 24-1-1985 

The subdivision of the set of segments into a first 
subset containing the straight parts of the road network 
and a second subset containing the curved parts of the road 
network gives a refinement in the distribution which simpli- 
fies the transposition. For of course by dividing the part 
of the road network by one (straight road) or more sections, 
a perpendicular projection can be made from the generated 
vehicle position coordinate onto such a section. The de- 
termination of a perpendicular projection onto a section is 
simple to realise under control of a microprocessor. The 
selection for determining in respect of which segment of the 
said group the generated vehicle position coordinate be- 
longs is improved in this way, namely by ascertaining 
whether the perpendicular line from the calculated vehicle 
15 position does in fact bisect a point belonging to the sect- 
ion and not a point situated on an extension of the section. 
For, if the point of intersection lies in the extension of 
the section, then this is not a point that belongs to the 
part of the road and thus the Transposition cannot be re- 
garded as being valid. 

A third preferred embodiment of a navigation system 
in accordance with the invention is characterized in that 
the point of intersection of two successive sections from 
the said number forms a breakpoint and the transposition 
perform a transposition by determining the distance between 
the calculated vehicle position coordinates and at least 
one breakpoint. 

In the case of curved parts of the road this offers 
a supplementary possibility for performing the transposition 
and thus increases the accuracy of the navigation system. 

A fourth preferred embodiment of a navigation system 
in accordance with the invention, whereby for each segment 
the axis of the appertaining part of the road is parametris- 
ed by means of at least one section, is characterized in 
that the transposition means perform a transposition by de- 
termining the distance travelled between a reference point 
of the relevant segment and the calculated vehicle position 
coordinate, and subsequently transposing this distance, on 
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the sections of the relevant segment, thereby taking the 
reference point as the point of departure. 

When use is made of an accurately calibrated speedo- 
meter, the path travelled can accurately be determined. The 
accurately determined path travelled is then transposed to 
the part of the road, which then quite simply gives the 
transposed coordinates* When the vehicle is provided with 
a calibrated speedometer, this system provides a very at.^rac 
tive and easily implemented solution which in addition 
possesses a relatively high accuray. 

A fifth preferred embodiment of a navigation system 
in accordance with the invention is characterized in that 
the central unit connected with the position-locating means, 
contains detection means which are provided in order to de- 
tect from the driving direction as determined with the 
position-locating means large momentary changes in the 
driving direction of the vehicle and for generating a second 
correction signal upon ascertaining a large momentary change 
in the driving direction, which detection devices are con- 
nected with the route-determining unit and are provided in 
order under control of the second correction signal to re- 
trieve driving route coordinates and to ascertain whether 
these momentary driving route coordinates contain the 
coordinates of a nodal point or a break-point and, in 
establishing coordinates of a nodal point or a breakpoint, 
to generate a third correction signal, which transposition 
means are operable to determine a correction vector under 
control of a received third correction signal. A large 
momentary change in the driving direction occurs when the 
vehicle takes a sharp bend in the road (break-point) or 
when it changes direction at a nodal point. When such a 
large change in the driving direction occurs and the vehicle 
is situated in the vicinity of a break-point or nodal point, 
which can be ascertained on the basis of the driving route, 
then it is possible to replace the generated vehicle posit- 
ion coordinates by those' for the breakpoint or nodal point 
under control of the correction vector. The detection means 
thus provide a supplementary improvement of the navigation 
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system and so make it more reliable. 

A sixth preferred embodiment of a navigation system 
in accordance with the invention is characterized in that the 
correction unit contains an operator generator Tor gene- 

5 rating from the measured speed and lateral acceleration of 
the vehicle and from the generated vehicle position coordi- 
nate an acceleration operator, which correction unit further 
contains an operation unit which has a first input connected 
with the selection unit for receiving the selected correction 

10 vector and a second input connected with the operator gene- 
rator for receiving the acceleration operator and a third 
input connected with the control unit for receiving a fourth 
correction signal, which operation unit is provided for 
causing the acceleration operator to operate on the selected 

15 correction vector under control of the fourth correction sig- 
nal and for generating therefrom a correction value for the 
measured acceleration. The generator acceleration operator 
operates on the selected correction vector and from this a 
correction value is then determined for the measured accele- 

20 ration. The determination of a correction value for the 

measured acceleration makes it possible to correct measuring 
errors in the acceleration measured with the accelerome ter 
and in this way to produce a more accurate value of the 
measured acceleration. 

25 A seventh preferred embodiment of a navigation system 

in accordance with the invention is characterized in that 
the operation unit has an output connected with the position- 
locating means for delivering the correction value to the 
position-locating means which are provided in order to take 

30 up the presented correction value in the measured lateral 
acceleration. 

Since the vehicle position coordinates are generat- 
ed from the measured acceleration and speed, whenever a cor- 
rection is applied with the aid of the correction value to 
35 the measured acceleration, the acceleration value will be 
more accurate and in this way the vehicle position coordi- 
nates will also be determined with greater accuracy. 

It is advantageous that the central unit contains a 
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non-volatile memory element which contains a control input 
for receiving an enabling pulse generated upon the stopping 
of the vehicle and which non-volatile memory is provided 
for storing the last generated vehicle position coordinate- 
under control of the enabling pulse and for preserving - he .:.*■-■■ 
vehicle position coordinates when the vehicle is stationary* 
Since the destination of one journey is usually the starting 
point of the next journey, and since the coordinates of that 
destination have been determined with great accuracy, it :* = 
advantageous to store in the non-volatile memory the vehicle 
position coordinates that were generated just before the 
vehicle was stopped. In this way, upon a subsequent jo^ri^y- 
they are then retrieved from the non- volatile memory and 
the starting point of the next journey is at once known. 

A more elaborate embodiment of a navigation system 
in accordance with the invention is characterized in that 
the navigation system comprises a receiving unit connected 
to the communication line for receiving position coordinate 
signals originating from a navigation satellite, and thai 
the central unit comprises a winding unit connected to the 
communication line for mixing, under the control of a mixing 
signal generated by the control unit, a set of generated 
vehicle position coordinates with position coordinates re- 
ceived from the navigation satellite, which last-mentioned 
generated vehicle position coordinates and received position 
coordinates relate to the same position, the mixing unit 
composing a Kalman filler for realizing the said mixing, 
the said mixing unit being connected in the correction unit 
for receiving the correction value and/or the correction 
vector. 

By combining a satellite navigation system with a 
dead reckoning navigation system it is possible to deter- 
mine the vehicle *s position more accurately. As a matter of 
fact, the deviation on the generated vehicle position coor- 
dinates is not correlated with the deviation on the position 
coordinates originating from the satellite. By mixing the 
two position coordinates which relate to the same position 
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by means of a Kalman filler, optimum position coordinates 
of the vehicle are determined. The mixing signal ensures that 
at suitable instants, when, for the same referred position, 
both generated vehicle position coordinates and position 

5 coordinates originating from the satellite are available, 
these are combined. The Kalman filter also uses the cor- 
rection value and/or the correction vector for mixing the 
position coordinates * 

The invention will now be further described by way 

10 of example with reference to the accompanying drawings in 
which 

figure la shows a vehicle that is moving along a 

road ; 

figure 1b shows the vector analysis of the accelerat- 
15 ion vector of the vehicle; 

figure 2 shows the main components of a vehicle 
navigation system in accordance with the invention; 
figure 3 shows a road network; 

figure k depicts the change in the speed vector 
20 and the acceleration vector with a moving vehicle; 

figure 5 shows a vector diagram for determining 
the deviation between the actual vehicle position and the 
calculated vehicle position; 

figure 6a is a flow chart of a main program for 
25 the operations of the correction unit; 

figure 6b is a flow chart of a subroutine "segment 
determination" ; 

figure 6c is a flow chart of a subroutine "deter- 
mination of e,A"; 
30 figure 6d is a flow chart of a subroutine "deter- 

mination of breakpoints"; 

figure 6e is a flow chart of a correction sub- 
routine ; 

figure 7a shows the choice from among different 
35 roads of a road network for selecting the road to which 
calculated vehicle position coordinates belong; 
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figures 7b and 7c show validity criteria for 
position co-ordinates transposition; 

figure 8 shows the parametrisation of a part of 
a road to be used for transposition of the road travelled; 
5 figure 9 is a flow chart of a subroutine "change 

in driving direction"; 

figures 10a and 10b show two orientations of a 
vehicle ; 

figure 11a gives an example of a hardware imple- 
10 mentation for determining the correction values; 

figure 11b is a flow chart of an a-correction pro- 
gram for determining a correction value to be applied to 
the acceleration signal; and 

figure 12 gives an example of calculated vehicle 
15 position corrections by making use of the program from 
figure 11b. 

figure 13 shows an embodiment of a vehicle navi- 
gation system in which a dead reckoning data processing 
system and a satellite navigation system are combined. 

20 Figure 1 (a) illustrates a vehicle V that is moving 

along a road C. The road and the vehicle are localised in 
a reference system (at rest) with coordinates x, y, z. At 
each moment the vehicle is situated at a position 
( x v » Y v > z v ) in that reference system. The starting 

25 position of the vehicle is indicated by the coordinates 
(x , y . z ) of the starting point P. When the vehicle 

Jr tr P 

travels at a speed v in the forward direction it also 

experiences an acceleration a. The acceleration vector a 

can, as is known for vectors, be analysed into a parallel 
— ^ 

30 component a ^ and a component a j_ perpendicular to the 
path of the vehicle. Figure 1(b) shows this vector 
analysis. In the further description only the lateral 
acceleration component aj_ will be considered and this 
will be denoted simply by Since the lateral accelerat- 

35 ion is always perpendicular to the path of the vehicle, it 
is possible to derive information about the driving direct- 
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ion of the vehicle from the lateral acceleration. 

With a land vehicle navigation system in accordance 
with the invention, use is made of the speed and the la- 
teral acceleration for determining the position at which 
the moving vehicle is located. The magnitude of the speed 
v of the vehicle is measured in conventional manner, for 
example by means of a speedometer. For measuring the 
scalar value a of the lateral acceleration a , the vehicle 
must be provided with an accelrome ter . The principle of 
an accelerome ter is for example described in Proceedings 
IEE, Vol. 12b, No. 11R, November 1979, TEE Reviews, 
p 10^3-1045. A calibrated speedometer in a vehicle is a 
reasonably reliable and sufficiently accurate instrument. 
A simple accelerome ter is however not sufficiently accu- 
rate, so that corrections to the measured value are 
necessary. In the further description this correction will 
be dealt with in more detail. 

Figure 2 shows the main components of a vehicle 
navigation system for a vehicle built to move over roads 
on land in accordance with the invention. The vehicle 
navigation system contains a control unit 1, for example 
a first microprocessor (Motorola 6&000) which is connected 
to a communication bus U for transporting data, addresses 
and control signals. Also connected to this bus are a 
working memory 2, for example a RAM, and a mass storage 
device 3. The mass storage device 3 is formed by a Compact 
Disc memory ( CD-ROM) which can be played on a Compact Disc 
player which, for example, forms part of a sound in- 
stallation with which the vehicle is equipped. Stored on 
this Compact Disc in the form of digital data are 
geographical data on the road network of a country or a 
part thereof as well as town maps with street names, sights 
of interest, hotels etc. of that country. The navigation 
system further contains a measuring unit 16 provided with 
an accelerometer 6 and a speedometer 7 ("which may possibly 
be an odometer) which are connected with respective inputs 
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of an analog-digital converter 3. The analog-digital con- 
verter 5 is in its turn connected with a second micro- 
processor 8. The analog-digital converter 5 and the second 
microprocessor 8 form together the position-locating means 
12 of the vehicle navigation system. The position- 
locating means constitute a dead-reckoning data processing 
system. This second micro-processor calculates inter alia 
the position coordinates of the vehicle from the speed v 
and the lateral acceleration a measured by the speedometer 
7 and accelerometer 6. The second microprocessor 8 is 
likewise connected with the bus k. Also connected with the 
bus 4 is a communication unit 18 which contains a keyboard 
and/or data pad 9. By means of this keyboard and/or data 
pad the user introduces data into the navigation system. 
These data are for example the starting position, the 
destination and possible preferences such as a route via 
a main highway or a tourist road. The communication unit 
18 further contains a loudspeaker 10 which is connected 
via a speech generator 1 h with the bus k, and further an 
image generator 15 to which a display device 11 is con- 
nected. The loudspeaker 10 may form part of the sound 
installation with which the vehicle is equipped. Through 
the loudspeaker and/or the image display device the user is 
given information on the road to be followed in order to 
reach the destination. It is not necessary for the naviga- 
tion system to contain both the loudspeaker and the image 
display device; one of the two is sufficient. It is also 
possible to connect the digital output of the car radio 
13 with the bus h. This is particularly advantageous when 
the car radio is provided for receiving digital traffic 
information by the Radio Data System (RDS). This traffic 
information can be taken up in the navigation system and 
processed therein. In this way, when determining the road 
to be followed, account can be taken of possible tailbacks, 
or warnings can be given of dangerous situations such as 
for example a vehicle travelling on the wrong lane of a 
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motorway or an icy surface. RDS is a system with which, 
digital traffic information can be transmitted on a 
subcarrier (57 kHz)for the stereo radio signal without 
interfering with the latter. 

An alternative to the keyboard and/ or data pad 9 is, 
for example, a microphone coupled with a speech recognition 
device in order to give information orally to the navigation 
system. 

The control unit 1, the mass memory 3» the working 
memory 2 and the position-locating means 12 constitute 
the central unit 17 of the vehicle navigation system. 

Before going further into the operation of the 
navigation system in accordance with figure 2, it is 
necessary to explain the geographic data stored in the 
Compact Disc in more detail. 

Figure 3 illustrates a part of a road network 20. 
The translation of the road data is based on the axes 
of the roads which are divided into straight line sections. 
Each line section has a starting point and an end point. 
To each starting and end point belong coordinates, which 
represent the coordinates (x, y, z) of a position vector 
with respect to an origin of a reference system. Each line 
section can also be represented by at least one position 
vector in that reference system. Two or more roads inter- 
sect each other at a nodal point 21 which is also re- 
presented by means of a position vector. The position 
vectors pertaining to the same part of the road is denoted 
as a segment. A segment is always bounded by two nodal 
points. A road network thus contains a set of segments. 
When the road is a straight road (23) then the segment 
is represented by only one vector, together with the vector 
for the two nodal points which bound the segment. When, on 
the other hand, the road follows a curved line, then a 
segment contains in addition a number of breakpoints. A 
breakpoint 22 represents the initial point of a subsequent 
position vector which describes a section of a curved road. 
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The straight road segments form a first subset ,of the set 
of segments and the curved road segments form a second 
subset. 

Also belonging to a segment are a place mme and 
street name, or a road number, depending on the location 
of that segment, which are also stored on the Compact 
Disc. This makes it possible to search on the basis of 
place and street names or road number. In general such a 
segment is stored in the Compact Disc by means of a data 
block. The data block then contains: 

- the province or the district 

- the location (town, village, etc.) 

- street name or road number 

- coordinates x, y, (and 2 when working three-dimensionally) 

- breakpoint coordinates for a curved segment. 

- weight factor y , characterising the nature of the road. 
Thus?, for example, a main highway (motorway) is allotted 
a low weight factor and a shopping street a high weight 
factor ; 

- the two nodal points of the segment are characterised as 
such (for example by means of one or more well-deter- 
mined bit values or well-determined positions in the 
data block) ; 

- an indi cation of a one— way or two— way street, with 
direction indication for one-way traffic; 

- roads that connect to that segment are also included in 
the relevant data block by means of coding and addresses 
that refer to other memory locations; 

- a reference to a location where particular information, 
such as the presence of traffic lights, obstructions and 
other topological data of the segment. 

Other information can also be stored in the Com- 
pact Disc such as for example addresses (and telephone 
numbers) of hotels, petrol stations, etc. 

The use of a Compact Disc as a mass storage device 
for a vehicle navigation system offers many advantages, 
mainly the large storage capacity (main storage: 4, 
k x 10 9 bits) and the random access capability which makes 
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reasonably rapid retrieval of data possible. The use of a 
Compact Disc player in a vehicle for inter alia navigation 
purposes is described in the proceedings of the SAE con- 
ference, Detroit, Michigan, February 27 - March 2, 198^ 
5 entitled "Application of the Compact Disc in Car Informat- 
ion and Navigation Systems 11 by M. Thoone and R. Breukers 
(Publication number 840156). 

Vhen a driver of a vehicle, "which is fitted with 
a navigation system as illustrated in Figure 2, wishes to 
10 use that navigation system, he will begin by entering 

into the navigation system via the keyboard or data pad 9 
his starting position (district, location, street name 
or road number), and also Ms 'destination. The starting 
position can for example also be called up from a non- 
15 volatile memory designed for the purpose, in which is 

stored the position last reached by the vehicle as deter- 
mined from a preceding navigation operation. It is possible 
to provide the navigation system with a number of options 
with which the driver can communicate to the navigation 
20 system one or more preferences, such as for example a 
preferred route via a motorway or via a circular road 
instead of right through a town. Making preferences known 
is done for example by means of a question and answer 
dialogue between the navigation system and the driver. The 
25 navigation system reports the possible alternatives for 

example by means of questions which appear on the display 
screen 11 and the driver answers via the keyboard 9» Pre- 
determining the route to be followed the navigation 
system then takes the driver's wishes into account. 
30 Af ter the driver has communicated the necessary 

data to the navigation system, the data for a number of 
segments is then, under control of the control unit 1 , 
called up from the means storage 3 and stored in the 
working memory 2. The working memory and the control unit 
35 together fulfil the task af a route-determining unit. This 
number of segments comprises the segments that are needed 
for determining the route c The purpose of calling up this 
number of segments is that, when a CD ROM is used as a 
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means storage, the Compact Disc player need only very 
briefly be used for navigation purposes, so that the player 
can be used during the rest of the journey for playing 
audio discs, and it further serves for retrieval to allow 
quick and automatic determination of the route. 

Determination of the route to be followed and the 
giving of navigation information to the driver are done in 
the knovn manner, as described for example in "Forschung 
jStrassenbau und S trass enverkehrs technik, Heft 222, 1978" 
and published by the German "Bundesminis ter fib? Verkehr" 
in Bonn, 

A more detailed account will now be given of the 
determination of the vehicle position coordinates during 
the movement of the vehicle along the road. The initialisat 
ion of the navigation system is done after the driver has 
communicated his starting position to the navigation 
system, for example by means of information (street name) 
a first nodal point, and at the moment that he reaches 
that first nodal point after driving away with his vehicle 
At that moment the driver initialises the navigation system 
for example by depressing an initialisation key. The 
coordinates (x Q , y Q ) belonging to that first nodal point 
are read from the backing store and are regarded as the 
initial coordinates of the route. The starting value of 
the directional angle determined relative to a referen- 

ce direction, for example west-east, is established by 
asking the driver in which street or on which road (road 
number) he intends to drive after crossing the first nodal 
point, or by means of a simple compass. With the initial 
coordinates (x Q , y Q )as point of departure the first 
microprocessor now determines an address for a subsequent 
vector which is to be called up from the working memory 
and which identifies a next segment on the route to be 
taken by the vehicle. 

The path over which the vehicle travels is cal- 
culated with the aid of the lateral acceleration deter- 
mined by the accelerome ter 6 and the speed measured by 
the speedometer 7o The analog-digital converter 5 
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translates the measured analog acceleration and speed 
values into digital values which, are subsequently delivered 
to the second microprocessor 8. From these digital 
acceleration and speed values the position-locating devices 
nov calculate the vehicle position coordinates of* the 
moving vehicle as described in the following. 

Figure 4 illustrates the change in the speed 
vector and the acceleration vector with a vehicle in motion. 
The vehicle moves over a path 30 and at the time t 1 at the 
place Q it experiences a velocity and a lateral 

acceleration "a£j • The path is approximated by describing a 
segment of* a circle of radius R relative to a centre point 
0. 

At the time t^ the vehicle is situated at the place 
P and now experiences a velocity v£ and a lateral 
acceleration a^" In the time interval dt = t^ - t ^ , which 
is infinite simally small, the vehicle has thus travelled 
over a path ds along the road ( circumf erence of the circle) 
and the directional angle of the vehicle has changed by 
dj^ . In A 0PQ f , P = 90°, since 0P.X ~| ^ 0PQt is 
thus a right-angled triangle 0 

Now d ^ ^ 1 rad, such that Q and Q' virtually 

coincide and tan d if ~ d ( 1 ) . Further, ds ^ vdt (2) 

and ds ~ PQ 1 (3) . 

In A OPQ 1 we now have pn< 

tg d 9? = (4) 

Substituting (l), (2) and (3) in (4) gives 

d,- — 

or R d = vdt (5) 

Further the vehicle experiences the centripetal force 

F = mv (6) and Newton 1 s third law F^ = m.a. (7) is 
cp a 

valid (here m represents the mass of the vehicle). 

Since the vehicle is in equilibrium on the road, we can 
write; 
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Substituting (8) in (5) now gives: 

.z 



a 



— — d tp — vdt 
a 



vtpdi = adt 



p=2- (9) 
v 

From the physical interpretation of* this expression 
(9) one learns that the quotient of 1 lateral acceleration 
a and velocity v gives the change in the driving direction. 
With (x, y) as path coordinates or the vehicle and 
y as the driving direction we can now draw up a next set 
of* differential equations. 



a 

p = — 
v 



(10) 



x = vcos<p 
y = v sin? 

Now ~ subs tituting c = cos if and p = sin if then 



(Hi 



P = c<p 



Substituting (9) in (11) then gives: 
v 

■ — cg 

Ve now define the vehicle position vector as S - P 

J/J 



Then 



x 

2/, 



— qp 



ac 
v 
vc 
vp 



(12) 



where f (z, t) gives the vehicle path algorithm. 

The set of differential equations (12) is now 
solved numerically and periodically with a period *TT 
(£*^0, is) by the second microprocessor 8. To that end 
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sampling is done with that period f and under control of* 
that second microprocessor for the values of* v and a 
measured "by the speedometer and the accelerometer. 

Discretisation in accordance /with the mid-point 
rule then gives .vith a sampling period for the vehicle 
path algorithm 



+ 1 



(13) 



where and ^ represent two successive values of* the 

n+ 1 n ^ 

vehicle position vector at the times (n+1 ) 'T? and n'^ • 
Substituting (13) in. (12) now gives 



15 



l_Pn + l 
T ^n + l 



20 



Pn 



2 



2 



(14) 



25 This equation gives a solution for the vehicle path 

algorithm. The values and v n+ ^ give respectively the 

acceleration and the speed as sampled at the moment 

(n+-r) ^ • The vehicle path algorithm thus contains a 

system of* Tour equations with four unknowns (c p * • 

J v n+1 *■ *n+ 1 9 

x „ , y ) • The values c , p , x and y , abbreviated to 
n+1 1 n+1 ' n* n J n •'n' 

"z^, are known from a previous solution of tjie algorithm. 
For a first solution of the algorithm, one uses for the 



30 



35 



P 



O 



value the initial coordinates c Q = cos ^ 

sin Lf 0 , x Q and y Q generated upon the initialisation of 

. — *y 

the navigation system, A solution Z n+ «j of the vehicle path 

algorithm thus represents a vehicle position vector. The 

vehicle path algorithm i9 recurrently solved, since of 

course use i3 made of "z^f or calculating"!^ - . 

n n+i 
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Hovever, the presence or errors in the measured 



5 




The latter is illustrated in figure 3 where the points 
represent the calculated coordinate points of the vehicle 
position vectors. Since use is consistently made of 
previously calculated coordinate points of the vehicle 

10 position vector, a cumulative effect occurs as a result 
of which the deviations relative to the actual vehicle 
position become steadily larger. It is thus necessary to 
apply a correction to the calculated coordinates for the 
vehicle position vector. If it is now assumed that the 

15 vehicle can move only along the road, the calculated 
position can be regularly corrected. This is done by 
comparing the generated vehicle position coordinates with 
the coordinates of the nearest segment of the actual path 
as stored in the backing store* A first method of correct- 

20 ing the calculated coordinates for the vehicle position 
vector comprises a transposition whereby a perpendicular 
line from the calculated coordinate point for the vehicle 
position vector is projected on to the actual path 
position vector for the nearest segment. 

25 A second method comprises another transposition 

whereby the road travelled is determined and this is 
fitted along a parametrised path as stored in the bearing 



30 will be described with reference to the vector diagram 
given in figure 5. In that figure 5 a curved segment 30 
is represented by means of a number of line sections 



point O represents the origin of the reference system. 

Assume now that during the travel of the vehicle 
over line section s i of the road 30 the point D is 
calculated on the basia of the vehicle path algorithm 



store. 



The mathematics on which the first method is based 
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and the measured values for v and a. Cleanly the point D 
does not belong to the line section s^ f so that correction 
is necessary. From the point D a perpendicular line is 
dra-wn to s., which bisects s. at the point M. The vector 
5 DM is denoted by "e? and gives the deviation (correction 
vector) between the calculated coordinate point D of the 
vehicle position vector and the segment in which the 

actual vehicle position lies. The vector SD^is denoted by 
h. and OD is denoted by z • Ve can now write: 

x N x 

The line section SM is a part of* the vector such that 

SM can be denoted by A s^, where A is a scalar and 

0 ^ >v ^ 1. 

15 It also applies that: e"£ = J\ s"^ - 1? (21). 

Since DM JL "s* it now holds that "e? -L sT^and thus that 
x 7 xx 

their product is 

sp = o (22) 

Substituting equation (21 ) in (22) yields 
(e ±f s ± ) = ( A s ± - h if s£) 



25 



30 



35 



(23) 



(i?, I?) 
v x f x y 

The value of* ^ can now be calculated by substituting 

the x and y values of the vectors z? r , 1?. and 

N x x+1 

equation (2k) and calculating their products. 
Substituting equation (20) in (21 ) yields: 

e> (25) 
Prom equation (25) and by substituting the calculated 
value of A , one can now determine ~e^ and J e^ \ . 

The correction of the calculated coordinates of 1 
the vehicle position vector with the aid of the actual 
road position coordinates from the digitised road network 
can be implemented in various vays e A first preferred 
embodiment will be described with reference to the flow 
chart shown in Figures 6a to 6e« The flow chart shown 
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in Figure 6a is that of a main program which is executed 
under control of 1 the first microprocessor (1 ixi figure 2) 
of the vehicle navigation system*. The flow chart shown in 
Figure 6b is that of the subroutine "determination of 
segment" which is likewise executed by the first micro- 
processor. The flow charts shown in Figures 6c and bd are 
those of the subroutines "determination of e* A " and 
"determination of breakpoints " , respectively, which 

are preferably executed under control of the second 
microprocessor. The flow chart shown in Figure 6e is that 
of the "correction subroutine", which is also preferably 
executed by the second microprocessor. The control unit 
1 f the working memory 2, the mass storage device 3 and 
the position-locating means 12 thus operate as a correction 
unit. 

The main program for the operations of the cor- 
rection unit (Figure 6a) is executed at least once per 
segment and for segments are longer than, say ( ^ 700 m) , 
the main program is periodically repeated for exemple 
every 10 to 20 seconds, depending on the accuracy of the 
position— locating devices. 

After starting of the main program (l4o) a first 
correction signal is generated (l^l) for handling the 
subroutine "determination of segment". The handling of the 
subroutine "determination of segment" also implies the 
handling of the subroutines "determination of "e^ -A" 
"determination of "e^- breakpoints" (lk2) m Vith the result 
from the preceding subroutines a "correction subroutine " 
(l^3) is then completed. This correction subroutine may 
possibly be supplemented with the subroutine "change of 
driving direction" (lkk) Q Terminating the subroutine 
"change of driving direction" also signifies the ter- 
mination (1^5) of the main program. 

The subroutine "determination of segment" (figure 
6b) is started (50) as a part of the main program. This 
subroutine begins with an investigation (51 ) of whether 
the vehicle is still located in the same segment. This 
investigation is done for example by checking on the 
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basis of* the route description the results or a previous 
execution of the subroutine "determination of* segment" 
and the speed of tlie vehicle, for the segment that vas 
driven into in the said previous execution. Further, a 
check is also made here on vhether the vehicle is still 
situated near a nodal point (in a radius of + 300 m 
around the nodal point), in which case an indicator is 
set. 

If the vehicle is still in the same segment (y) 
then a move is immediately made to step 57 where a jump 
operation is performed to the subroutine "determination of 
e, A £f» on the contrary, the vehicle is no longer in 
the same segment (n) , or if an indicator has been set, then 
a selection is made (52) of a group of segments situated 
within a given radius (for example 350 m) around the 
calculated vehicle position as represented by the generated 
vehicle position coordinates 0 This selection is made by 
using the data block belonging to the last-determined 
segment and taking account of the direction in which the 
vehicle is moving, by selecting the data blocks of the 
adjoining segments 0 The number ( )( ) of segments from the 
said group is then counted (53) and a first counter with 
that value ( Y ) is initialised (5^). Next, a first 
segment is selected from the said adjoining segments (55) 
and the first counter is reduced by one position 
( = ^ - l) (56). Then a jump operation is made to the 
subroutine "determination of ^ X " . After execution of the 
subroutine "determination of e , A " the value determined 
for the correction vector (^) is stored with the 
associated segment number in a first table (58). Next a 
jump is made (59) to the subroutine "determination of e 7 , 
breakpoints". Then a check is made (60) of whether the 
first counter has reached zero ( $ = 0 ?), in other words 
to determine whether the subroutine " determination of IT* \ » 
and the subroutine "determination of "e*, breakpoints" have 
been executed for each of the said segments of that group. 

If the first counter has returned to zero (y) then 
the smallest ^e 7 value "^^^ is selected (62) from the e* 
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values stored in the first table ^ This smallest e > value 
e ~ with its associated segment number is stored in a 
first register. This terminates the segment determination 
subroutine (63). If the first counter has not returned to 
zero (N), then a subsequent segment from the said group of 
segments is selected (61) and the subroutine "determine on 
of segment" is repeated starting from step 56. 

The execution of the subroutines 57 and 59 Tor all 
the segments of the group is important for determining 
which way the vehicle is going to travel after the nodal 
point has been passed, and in so doing also to determine 
the relevant segment with respect to which correction 
operations are to be carried out. In a situation as depict- 
ed in figure 7a, the vehicle that is situated at nodal 
point 83 may take either road 80 or road 81. In a trans- 
position formed by the perpendicular projection of the 
calculated point D onto the line sections s"* or "s 3 ^ belong- 
ing to road 80, the perpendicular line from D bisects the 
line sections s"^ or *s£ in their extension. This has the 
consequence that the value for A upon projection onto 
s a or s b* res Pectively, is larger than one or smaller than 
0, respectively, i . e . }< ££0 , ll and the transposition is 
consequently invalid. The segment of road 80 is thus 
evidently not the road along which the vehicle is moving. 
The choice of another road and thus of another* segment is 
necessary. The other segment is for example that belonging 
to road 81 which lies in the vicinity of road 80 and 
moreover has a nodal point 83 in common with road 80. 
The perpendicular projection of D on to "s"^ will now yield 
a valid value for A that lies between 0 and 1 . 

The flow chart depicted in figure 6c illustrates 
the different steps of the subroutine "determination of 
e, A With this subroutine a transpostion is determined 
of the calculated vehicle position coordinate to a line 
section of a segment belonging to the said group and also 
a value for the correction vector ~e? 

The subroutine "determination of "e 7 ,A " is started 
(120) as a part of the subroutine "determination of seg- 
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ment" (step 57) • subroutine "determination of 1?, A " 

begins (l2l) by calling up the most recent vehicle position 
coordinates for the position vector z^. as calculated by 
means of the vehicle path algorithm. The vehicle position 

5 coordinates are calculated under control of the position- 
locating devices and are for example temporarily stored 
in the internal memory. After the calculated vehicle po- 
sition coordinates for z^. have been called up (l22) and a 
second counter started (± = 1 ) which counts the number of 
line sections contained in the segment, the coordinates 
of the first (s . ) line section belonging to that segment 
are determined. Vith the value for z„ and the value for 
s 1f a determination (123) is nov made (as given by the 
expressions (20) and (23)) of the value of A and this is 

15 stored in a section table. 

Next, a check is made (124-) vith the A key 

whether 0 ^ A <C 1 . If A indeed has a valid value between 

the number 0 and the number 1 (y) , then the vector "e* for 

the line section is determined (125) (as given by ex- 

20 pression (25)) and also its length! e 1 | being the distance 

■ > 

between the calculated coordinate point z^ and the 
transposed coordinate point of zj^. Two alternatives are 
now possible for the subroutine "determination of X n » 
In a first alternative a check is made (126) 
25 whether | e^is smaller than a given distance !L. For this 
purpose for example L = maximum is placed at step 122. 

If l^j is smaller than L (y), as it will be when 
L = maximum, then the value of | "e^ | is substituted for 
L (12?). By substituting in this way a smaller value |e^| 
30 for the value of L whenever J e^ l^^t the smallest value of 
e^ j is ultimately selected for this connection vector. 

In a second alternative the steps 126 and 127 are 
not executed but at step 125 the calculated value for 
is directly stored in the first table and a jump is then 
35 immediately made to step 128. Depending on the desired 

execution, either one of both alternatives can be selected. 

At step 128 the second counter is now raised by 
one position (i : =s ±+l) in order to examine a subsequent 
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Seotion from the segment • Next a check is maac ("I ;'?;-."/) 
to determine whether all sections of the relevant seg- 
ment have already been examined (i<m ?). This is done 
by compearing the position of* the second counter with the 
5 number of sections of* the relevant segment. If all sec- 
tions have not been taken into account (N), then the sub- 
routine is repeated from ste.p 123 for a subsequent section 

If on the other hand all sections of the relevant 
10 segment have been taken into account (Y) f then the subrou- 
tine "determination of "e* A " is ended for the relevant 
segment and a jump is again made to the subroutine 
"determination of segment" ( 1 30 ) in order to store the 
calculated "e^ values in the first table (58) if the first 
alternative was chosen. 

The subroutine "determination of ^A» gives a 
first possibility of determining one or more values of the 
correction vector e"^ by making use of the A key. Nov it 
may follow from the A key for the various sections that 
either several values of A satisfy and thus several "e 7 
values are determined, or no single value of A satisfies 
and thus no valid ~^ values are determined. A situation 
where several values are determined for ~eT is for example 
presented in figure 7b. 

It is assumed that point D represents the coor- 
dinate position of the calculated vehicle position vector 
z^. Vith perpendicular projection of D onto s^, the per- 
pendicular line from D bisects s d at , and with per- 
pendicular projection of D onto s^ the perpendicular line 
from D bisects s^ at Since now the transposed point 

is a point that belongs to section and the transposed 
point is a point that belongs to section s^, then 
AM^ s '\s^, KM 2 =X 2 s^ and both 0$. A^ <C 1 and O <T A 2 

^ ,# ^ 

Vith step 124 of the subroutine "determination of 
"e^ ^ " it is thus established that both A 1 and A 2 
satisfy the imposed criterion (A -key) and in this way 
both ^ = DM j and. "e^ = DM 2 are determined. In the first 



20 



25 



30 



35 
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table there are in this case two values for e . • 

x 

A situation where no single value for "e^ is 
determined in the handling of the subroutine "determinat- 
ion of e^ A " is shown for example in figure 7c 0 Assume 
5 again that the point D represents the coordinate position 
of the calculated vehicle position vector Z^. With 

perpendicular projection of D onto s the perpendicular 

g 

line from D bisects the on extension of section s at the 

E 

point M o Likewise the perpendicular line from D onto s, 

-* s, il 

10 bisects s^ in its extension at the point M^. Now AM^ = 

A 3 KM^ 7 = A 4 ^J, where A > 1 andA ^ < O. 

Since now neither of the two values A ^ f /{ ^ 
satisfy the criterion (o ^ A ^ 1 ) imposed in the in- 
vestigation of step 124, no values are determined for e< . 

15 Figure 6d shows the flow chart of the subroutine 

"determination of ~e? f breakpoints". This subroutine is 
started ( 1 3 1 ) during step 59 of the subroutine "deter- 
mination of segment". The subroutine "determination of "e^ 
breakpoints" is in fact supplementary to the subroutine 

20 "determination of "e^ A " and is thus a preferred embodiment 
of the functioning of a vehicle navigation system in 
accordance with the invention. 

The subroutine "determination of e, breakpoints" 
begins ( 1 32 ) with the counting of the number (/S ) of break- 

25 points in the relevant segment. The subroutine "determinat- 
ion of e^ A " and the subroutine "determination of e, 
breakpoints" are always completed successively for the 
same segment as also appears from -the flow chart of the 
subroutine "determination of segment" which is shown in 

30 Figure 6b . 

A third counter is next (133) positioned ii a 
position /3 which gives the number of breakpoints just 
counted. The position of the third counter is then (13^) 
investigated. If this position is zero (y) (all break- 

35 points dealt which, or there is no single breakpoint in 
that segment because it is a straight road), then this 
subroutine is ended and a jump is again made to the sub- 
routine "determination of segment" (139). If, however, 
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the position of* the third counter has a value different 
from zero (N), then (135) the coordinates of the breakpoint 
K indicated by the position of the third counter called 
up in order thereafter to determine (136) the distance 
d/3 (B, K/5 ) between the point D and the breakpoint K/J 
(see figures 7b and 7c). This distance d/9 (D, K/$ ) = e/5 
yields a supplementary value for e?, namely e^ = - , 
vhich is then stored (137) in the first table together 
with the segment number. Then the third counter is reduced 
(138) by one unit and the subroutine "determination or e, 
breakpoints 1 ' is repeated from step 13^o 

By making use of the subroutines "determination of 
~P' 9 ^ " and "determination of "e^ breakpoints" a series of 
values for the correction vector "e^ is stored in the first 
table. At step 62 of the subroutine "determination of 
segment" the smallest value "e 7 ^ k1 ^ for ~2 is then selected 
from this series. The segment number that belongs to the 
smallest value o± e T is then used to identify the segment 
in which the vehicle is situated at a given moment. 

The value "e^ C^ 1 ) is further used in the handling 
of the correction subroutine depicted in Figure 6e 0 The ^ 
correction subroutine is started (70) on command from the 
first data processing unit in the execution of the main 
program (step 1V), Figure 6a). In this correction sub- 
routine it is checked (71 ) whether that smallest value 
~?(kl) ±s smaller than a norm value, for example e norni - 

20 m (e^ k1 ^ < e ) . If that smallest value e (kl) is 

v norm 1 

smaller (y) than the norm value e norm , then a correction 

of the calculated vehicle position is superfluous and the 

correction subroutine is thereby terminated. If, on the 

( kl ) 

other hand, the smallest value e ± \ is greater than 

e (N). then this means that the deviation is too great 

norm x ' * 

and that a correction must be made. The correction is now 

— y (M) — > (kl) 
done (72) by vectorially adding Z N = Z N + e ± , xn 

pther words that smallest value of e^ (^) f to the cal- 
culated vehicle position vectpr^. The corrected value 
can now be used in as the reference position for 
calculating the next vehicle position coordinates by means 
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of the vehicle path algorithm. After determination of that 
corrected value Z^. a step is made bade again to the 

main program 0 

Yet another method fbr correcting the calculated 

vehicle position coordinates for the vehicle position 

vector is the "matching method" which entails calculating 

the travelled path and matching it along the actual path. 

This other method is illustrated with reference to the 

example in Figure 8, The vehicle moves along the part of 

the road 91 which is parametrised by the set of sections 

s , s, , s and s, and by the breakpoints K , K 0 and K„. 
a b e d 1 j 

Assume that the breakpoint represents the 
position defined by the road position coordinates that 
were obtained in a previous correction procedure (or are 
the coordinates for the initial road position). After the 
vehicle has driven a further time ^ t after the execution 
of the previous correction procedure, it has travelled 
from the reference point a calculated distance 1 = 
v A t (v being the average speed of the vehicle in the 
time -At) and on the basis of the vehicle path algorithm 
the coordinates of the point D are determined. Since the 
vehicle can only move over the road 91, it must hold 
that 

1 = M^;l +*2 l*ol + *3.| T di (30) 
0 ^, h ± ^ 1 ± £ { 1, 2, 3 ] (31). 

Although this equation (30) contains three unknowns , name- 
ly ^ i» 311(1 sK r>t can nevertheless be solved if 
account is taken of the boundary conditions given in (31 ) 
as also below: 

when 1 > 1 s^ | then X ^ must be equal to 1 (32) 
when 1 > j"s^ j + 1 *™s^ J then X -j must be equal to 1 and 
X 2 mvLS ^ be ec rual to 1 (33)o 

These two boundary conditions are based on the 
fact that gives the starting point from which 1 has to 

be measured along the road and on the fact that the 
vehicle can move only along the road. The example given 
in figure S shows that 1 >- j s^ j , but 1 <C | | + s^|, 
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so that 1 * i | + A 2 | 3 c I ' 

The transposed coordinates of the vehicle posiiion vector 
are thus Tor the position 

+ A o^l* 

2 2 3 | | 

^ Also determined is the distance | e j between the 

point D and this transposed position. 
I e I = Ik* j ^ A 2 k 3 ~Z (3*0 

The determination of* the value 1, the scalars A ^ f the 

10 vectors ' + A , e and done by means of* .the 

first and/ or the second microprocessor- ■Vhert this match- 
ing method is used it is of course also possible, as 
described for the use of* perpendicular projection, to 
transpose the calculated road travelled 1 to more than 

15 one nearby segment and then to select from these the 
smallest value of the correction vector, 

A supplementary method of correcting the calculated 
vehicle position coordinates is for example given by the 
subroutine " change of driving direction" for which the 

20 flow chart is shown in Figure 9* The subroutine "change 

of driving direction" is used in addition to the correct- 
ion subroutine (Figure be ) or to the above-described 
"matching method". The subroutine "charge of , driving 
direction" is, however, not of essential importance for the 

25 functioning of a navigation system in accordance with the 
invention, so that in a simple implementation of a 
navigation system in accordance with the invention it 
might possibly be omitted. 

The subroutine "change of driving direction" is 

30 started (l84) as a part of the main program (step 144) 

and is handled preferably under the control of the second 
microprocessor « The first step (85 ) that is completed in 
this subroutine contains the calling up of the momentary 
value of the direction angle y> as calculated from the 

35 vehicle path algorithm. This value of the direction angle 
is temporarily stored in a register* Next to be detected 
(86) is whether in accordance with the represented path 
the momentary value of the direction angle has changed 



PHN 1 1 . 122 



-32- 



0181012 

23-1-1985 



appreciably with respect to the preceding: value of the 
direction angle which is also stored in that register. 
An appreciable change or the value of the direction angle 
can in certain circumstances imply that the vehicle has 
driven over a nodal point or a break point and has pro- 
ceeded in a different direction. If the value of the 
direction angle is not (n) appreciably changed, then a 
shift is made to step 89 and with this the subroutine 
"change in driving direction" is ended 0 If on the contrary 
the value of the direction angle has (Y) appreciably chang- 
ed, then (90) a second correction signal is generated by 
the second microprocessor and under the control thereof 
current driving route coordinates are called up from the 
working store. These driving route coordinates contain 
data on the road network in a radius (approx. 100 m) 
around the last calculated, vehicle position. "With the aid 
of these driving route coordinates a check is now made 
(87) to determine whether the vehicle is situated at a 
nodal point or a breakpoint. If the vehicle is indeed 
(Y) situated at a nodal point or breakpoint, then a third 
correction signal is generated (88) and under control 
thereof coordinates of that nodal point or breakpoint are 
substituted (88) for the calculated coordinates of the 
vehicle position vector 0 If however, the vehicle is not 
situated at a-, nodal point or breakpoint (87, N) then after 
step 87 a jump is directly made to step 89. It would also 
be possible after step 87 and in the event that the ve- 
hicle is not situated at a nodal point to Investigate 
whether the vehicle has made an about turn. This latter 
information could then be processed or used for correction 
purposes . 

The correction vector ~e 7 and its length | e 7 I in- 
dicating the deviation between the calculated position 
coordinates and the transposed coordinates and which has 
been determined by one of the methods described in the 
foregoing can also be used for applying a correction to 
the measured value of the lateral acceleration, a , as 
determined by the accelerometer . 
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As already mentioned, simple accelerometers 
yield an insufficiently accurate measuring result, so 
that a correction has to be made to the result. Another 
factor that influences the accuracy of the result of a 
measurement with a simple accelerome t er in a vehicle is the 
tilting of the vehicle around an equilibrium position, for 
example as a consequence of a passenger stepping in or 
when the vehicle drives into a corner at high speed. Fi- 
gure 10a shows a vehicle in equilibrium and figure 10b 
shows a vehicle that has tilted by an angle ^ , called the 
tilting angle, around the equilibrium position (g repre- 
sents the acceleration due to gravity) o As a consequence 
of that tilting angle and acceleration error of the 
magnitude g sin ^ will be measured. A correction must 

be made for this. 

The conversion of the analog measured speed and 
acceleration values into digital values, the calculation 
of the path algorithm, in short the entire vehicle 
navigation system, makes use of electronic components. 
The operation of electronic components is influenced by 
the considerable temperature fluctuations and differences 
to which a vehicle is subjected (ranging from nearly 
-40°C to +70°C). For this, too, correction is necessary. 

The determination of a correction value Z\ a 
applicable to the measured lateral acceleration will be 
described with reference to Figures 11a and 11b e Figure 11a 
gives an example of a hardware implementation of a part of 
the correction unit, which part generates the correction 
value A a. The correction unit contains an operator 
generator 200 which has inputs for receiving the measured 
speed (v) and acceleration (a) as well as the calculated 
vehicle position vector This operator generates from 

the received quantities an acceleration operator § n in 
a manner which will be elucidated in the further descrip- 
tion. The acceleration operator is applied to an input of 
an operation unit 201, to which further the correction 
vector ~e 7 and a fourth correction signal (4c) generated 

by the first microprocessor are applied. The operation 



PHN 11. 122 



-3^ 



01 81 01 2 

23-1-1985 



unit 201 under control or the fourth correction signal 
causes the acceleration operator to act on the applied 
correction vector and generates therefrom a correction 
value A a# 

5 The generation of the acceleration operator g^ 

and the correction value ^ a will now be further 
elucidated with reference to the flow chart of the a- 
correction program depicted in Figure 11b* 

The a-correction program starts (lOO) as soon as 

10 the vehicle navigation system is initialised. The a- 

correction program "begins (id) by setting a fourth coun- 
ter to zero (k = o) as well as by storing an initial 
value for the correction value A a^. (for example A a Q =5 0) 
in a second register. Thereafter (102) a fifth counter is 

15 set to zero (n = 0 ) and the initial value of ths direction 

angle (if = 0 ) is stored in third register* Next (103) 

the speedometer and the accelerometer are sampled in ordep 

to call up the value v 1 and a ^ (see equation 14) and 

n-f^ n+r 

store the^e values in a fourth register of the operator - 

20 generator. To the measured value of the acceleration the 

position-locating means now apply a correction (l04) f 

namely a -1 - Aa, ♦ With this corrected value for the 

acceleration the vehicle position vector z , ^ is now 

^ n+1 

calculated ( 105 ) by making use of the vehicle path 
25 algorithm (equation 1*0 • The result of the calculation of 
z n+1 ^ s s ^ orec ^ ^or example in an internal, memory of the 
second microprocessor unit. After calculation of the 
vehicle position vector , , an acceleration operator 's? 
is now /determined, which acceleration operator g^ indicates. 
30 the sensitivity of the vehicle position vector io errors in 
the acceleration signal* For g^ it holds that; 

where represents the inverse of the acceleration 



35 



operator and e* is the correction vector (see equation 21 ) 



Thus e"j^ a ^ - z^V (4.1 ) where "z^^ represents the 

converted vehicle position vector as determined at step 
72 of the correction subroutine in Figure 6e t Proceeding 
from the initial value of the vehicle position vector Zq 
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the vehicle position vector can be determined vith 

the help of the vehicle path algorithm and the values 

Vi • a-i from the equation: 
T T 

*i=/(*o.vjt.fl») (42) 
where represents the vehicle path algorithm 0 
One now has a^a^+Aczo (43) 

where a 1 ^ represents the real value of the acceleration. 

Substituting- (^3) in (^2) now yields 

If now a 0 is very much less than the nominal value of 

the lateral acceleration, for example r.m.s. 



then a 



first order Taylor series approximation can be written for 
formula (44). 



where 



da 



(45) 



is the derivative of f to a 1 for n = 0, 



If the speedometer is sufficiently reliable, then Vj_ is a 

-7, -7 v — ;fM) / , r \ 2 

reliable value and T\z r . 9 v-, , ai ) = x\ J (46;. 

u T T 1 

We now define: 



da' 



(47) 



Substituting ^46 J and (47) in (45) gives 

Malcing use of the vehicle path algorithm and of the cal- 
culated vehicle position vector z^. , the vehicle position 
vector 2: 0 is determined in a subsequent treatment of 
step 105« 

*«=/(*i.«*«a) < 49 > 

Equation 49 can also be written as 

^2 = /(^i W +(^i-^i W ),t;rj i ,a t 1 j 4 +Aa 0 ) (50) 
Development of this in a Taylor series then gives: 



».=/(*i (jr) .«*a'^+ 



1L 



Aa 0 



(51) 
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Substituting (k8) in (51) and re-arranging (51 ) then 
gives 



5 Ve now define 



10 



15 



If 



da I, 



Aa 0 



(52) 



Then * 8 = « 8 ( * ) +^iAa 0 (3*0 

In general it can thus "be derived that the acceleration 



operator g n is given "by 



(55) 



Equation (55) thus gives a general expression for the 
determination of g n « 

returning to the a correction program (Figure 11b) 
the value for g^ is then determined in step 106 using 
equation <55). Next, a check is made (107) to determine 
20 whether a new value for the correction vector e k is 
already known (the value ~5^ (kl) is determined as describ- 
ed in the foregoing). If no value is yet known for "S^ (N) 
then the fifth counter is increased by one position (108) 
and the program is repeated from step 103 . If on the con- 
25 trary a new value is known for "e^ k1 ' (y) then this is 
retrieved from the first register (109) together with 
the real coordinates of the vehicle position vector 
?"( M ). Next (110), using the operation unit, a value for 



Aa^ is determined from 
k 



30 



^»=2r, W) +? n Aa t (60) 



35 



This new value for A"a* is now stored in the second 



register (111 ) where it replaces the present value A^.-, 
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The fourth counter too Is increased by one position. With 
this new value for A a^. and with the fourth counter in a 
subsequent position the a-correction program is repeated 
from step 102. At this step 102 the value is 
determined from zr^ v ' for the direction angle and stored 
in the third register. 

By the application of a correction value to 
the measured acceleration value, constant and slowly 
changing errors in the measured lateral acceleration are 
eliminated. These measures thus offer the possibility of 
using a simple and thus relatively cheap accelerometer 
in the vehicle navigation system in accordance with the 
invention. The correction of the measured lateral 
acceleration has positive consequences for calculating the 
vehicle position vector "zT ^ with the position-locating 
devices. When now instead of the measured value the A a^ 
corrected value is filled into the vehicle path 
algorithm . v ■ a , ) for a ^ , , then the error 

in the calculated position coordinates decreases con- 
siderably. This latter is shown in an example given in 
Figure 12. In that example the vehicle moves along a 
straight path which coincides with the x axis of the 
reference system. The vehicle has a speed of 20 m/s and 
the correction value A a ^ ± s chosen as A a Q = 0 0 5 m/s 2 
and the main program was executed every 30 seconds. The 
vehicle departs from the origin. In a first determination 
of the correction vector ""^v 1 * 11 ) this has a length of 
221.5 m. After application of the correction factor 
determined with the a correction program the deviation 
vector | e^j after a second determination is 33 m, and 
subsequently after a third and fourth determination the 
deviation vector is | e* | = 6.7 m and | e^ I = 1 . 5 m 
respectively. 

By making use of a vehicle navigation system in 
accordance with the invention the vehicle position coor- 
dinates can thus be determined with relatively high 
accuracy. 

When now the vehicle is stopped, then in fact the 
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last-determined coordinates are the coordinates of the 
starting point of the next journey made by the vehicle. 
Since these last-determined coordinates are now accurately 
known, they canreadily be used as the starting position 
5 for the next journey. To this end the central unit is 

provided with a non-volatile memory, for example incorpo- 
rated in the position-locating means, in which non- 
volatile memory these last-determined vehicle position 
coordinates are stored. The non-volatile memory is for 
10 example powered by the storage battery of the vehicle 

and is charged under control of a charging pulse generated 
upon stopping the vehicle, for example from the switching- 
off of the ignition. 

Using a correction value A a k on the measured value 
15 for the acceleration, as well as the determination of a 

correction vector e are means which serve to determine the 
vehicle position coordinates more accurately. An alternative 
way of determining the vehicle position coordinates is to 
use a radio or satellite navigation system, A known, already 
20 operative, radio navigation system is LORAN-C which is ca- 
pable of determining a position to an accuracy of approxi- 
mately 100 m. An example of a known satellite navigation 
system is the GPS (Global Positioning System - code name 
NANSTAR) which will be capable of determining a position to 
25 an accuracy of approximately 5ni. Further data on the systems 
LORAN-C and GPS, respectively, are stated, for example, 
in the articles "Current developments in LORAN-C" by R.L. 
Frank, Proceedings of IEEE, Vol. 71, No. 10 October 1983* 
pp . 1127-1139 and "Civil GPS from a future Perspective" by 
30 T.A. Stansell, Proceedings of IEEE, Vol. 71, No. 10, Octo- 
ber 1983, 2£. 1187-1192, respectively. 

The determination of a position to an accuracy of 
approx. 100 m is insufficient for use in a vehicle navi- 
gation system, so that the LORAN-C system is not to be 
35 considered for this purpose. An accuracy of 5ni on the con- 
trary is useful indeed so that satellite navigation with 
GPS is to be considered for vehicle navigation. However, 
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the determination of vehicle position coordinates on ^Y by 
means of GPS satellite navigation is insufficient because 
the signals originating from the satellites are not re- 
ceived continuously and free from distortion. A poor signal 

5 reception may arise, for example, from reflection of the 

radiation by obstacles, for example, high buildings, or by 
electromagnetic sheet noise. Notably the built-up area 
where great accuracy of the vehicle position coordinates 
is required, this type of interferences is particularly 

10 annoying. 

The combination of a satellite navigation system 
with the dead reckoning data processing system described 
hereinbefore provides a solution to mitigate the dis- 
advantages of the two systems individually* As a matter of 

15 fact, because the errors in a dead /reckoning data pro- 
cessing system are not correlated with those in a satallite 
navigation system, both systems may be considered to be 
complementary. 

Figure 13 shows an embodiment of a vehicle navigation 

20 system in which a dead reckoning data processing system 

and a satellite navigation system are combined. The vehicle 
navigation system comprises analogue elements such as that 
shown in Figure 2 (corresponding elements are referred to 
by the same numerals), as well as a receiver 300 for re- 

25 ceiving satellite signals. The receiver 300 is connected to 
the communication line 4 so that the signals received from 
the satellite are transmitted to the mass memory and the 
control unit. Receiving and processing GPS satellite signals 
is described, for example, in the article by R.J. Nilliken 

30 and C.J. Zoller "Principles of operation of NANSTAR and 

system characteristics". The Institute of Navigation, Global 
Positioning System, Special Issue, 1980. 

The vehicle position coordinates as determined by 
the dead reckoning data processing system and corrected in 

35 the manner described hereinbefore are combined under the 
control of the control unit 1 , with the position coordi- 
nates as received by receiver 300 in a mixing unit 301 which 
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forms part of the central unit. The mixing unit mixes the 
position coordinates in such a manner that an optimum po- 
sition of the vehicle is obtained. For this purpose the 
mixing unit comprises a Kalman filter. In the article ,r Sen- 

5 sitivity Analysis of an integrated NANSTAR GPS/lNS Navi- 
gation System to component failure" by H.M. Schwartz, 
published in Journal of the Institute of Navigation, Vol. 
30, No. k, winter 1983-84, pp. 325-337j two examples are 
given of how position coordinates originating from various 

10 sources are mixed by means of a Kalman filter so as to gene- 
rate one system of position coordinates the accuracy of 
which is substantially greater than that of the individually 
presented position coordinates. 

In signal processing by means of a Kalman filter for 

15 determining the system of combined position coordinates, use 
is made of the errors associated with each system of pre- 
sented position coordinates. In fact, each system of pre- 
sented position coordinates has an error value expressed 
in a contour of equal probability of position. In the ve- 

20 hide position coordinates as determined by the dead 

reckoning data processing system, the value of the correct- 
ion vector "e^^^") and/or the correction value a are used 
in the error value* The error values for the satellite navi- 
gation system are mentioned in the above article by H.M. 

25 Schwartz. 

The combination of the dead reckoning data pro- 
cessing system and a satellite navigation system hence pre- 
sents the possibility of determining the vehicle position 
coordinates with greater accuracy and thus realizing a 
30 more reliable vehicle navigation system. 



35 
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20 



25 



30 



CLAIMS ] 



1. Navigation system for a road vehicle, comprising 

a measuring unit which has a speedometer and which is 
linked with a central unit, a communication unit connected 
to the central unit for the input of a starting position 
and a destination and for the display of a driving route 
between starting position and destination, which central 
unit contains a mass storage device for storing geographic 
data of a road network,. a control unit and position-locat- 
ing means which are all connected with a common communi- 
cation line, which control unit contains a route-deter- 
mining unit for determining a driving route between the 
starting point and the destination by making use of the 
geographic data from the backing store, which position- 
locating means have a first input which is connected with 
an output of the measuring unit for receiving measurement 
data and are provided in order to determine from the mea- 
surement data, after receiving the starting position, 
successive vehicle position coordinates and the driving 
direction of the vehicle in motion, characterized in that 
the measuring unit contains an accelerometer for measuring 
the lateral acceleration of the vehicle and the position- 
locating means are provided in order to generate recurrent- 
ly from the measured lateral acceleration and speed of the 
vehicle the successive vehicle position coordinates and the 
driving direction of the vehicle in motion. 

2. Navigation system as claimed in Claim 1, which system 

contains a correction unit connected to the communication 
line for determining correction vectors that give the 
deviation between the vehicle position coordinates generated 
with position-locating devices and stored road position 
coordinates for a corresponding position on a part of the 
road, and for correcting the generated vehicle-position 
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coordinates therewith, characterized in that the geographic 
data of the road network contain a set of segments whereby- 
each segment represents from the road network a part of the 
road that is between two nodal points and is identified at 

5 least by the coordinates of these two nodal points and 

which correction unit is provided with transposition means 
for determining, under the control of a first correction sig- 
nal generated by the control unit, for each segment from a 
group of segments situated within a given radius around a 

10 generated vehicle position coordinates, a transposition of 
the generated vehicle position coordinates for a transposed 
vehicle position situated near the relevant segment, which 
transposition means are further provided for generating 
correction vectors that give distances between the generated 

15 vehicle position and its transposed positions, which cor- 
rection unit is further provided with selection means for 
selecting from these generated correction vector that vector 
which has the smallest distance among the said distances that 
belong to the same group, which correction is made on the 

20 basis of the selected correction vector. 

3. Navigation system as claimed in Claim 2, character- 
ized in that segments for parts of roads which run along a 
straight line form a first subset of the set of segments, 
and whereby the straight part of road is represented by 

25 one line section, and that the transposition means perform 
a transposition by determining, the perpendicular projection 
of the generated vehicle position coordinates, onto the 
line section of the relevant segment, and declares the trans- 
position as valid when the transposed position is a point of 

30 that line section. 

4. Navigation system as claimed in Claim 2 or 3, cha- 
racterized in that segments for parts of roads which follow 
a curved line form a second subset of the set of segments, 
that the curved part of a road is represented by a number 

35 of sections, and that the transposition means perform a 

transposition by determining the perpendicular projection of 
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the generated vehicle position coordinates onto at least one 
section from the said number of sections and declares the 
transposition to be valid when the transported position is a 
point of one of the sections. 

5 5, Navigation system as claimed in Claim 2, 3 or k 9 

characterized in that the point of intersection of two 
successive sections from the said number fomrs a breakpoint 
and the transposition means perform a transposition by de- 
termining the distance between the generated vehicle position 

10 coordinates and at least one breakpoint. 

6. Navigation system as claimed in Claim 2, whereby for 

each segment the axis of the appertaining part of the road 
is parametrised by means of at least one section, character- 
ized in that the transposition means perform a transposition 

15 by determining the path distance travelled between a ref- 
erence point of the relevant segment and the generated ve- 
hicle position, and subsequently transposing this distance 
on the sections of the relevant segment, thereby taking 
the said reference point as the point of departure* 

20 7 # Navigation system as claimed in one of the Claims 

2, 3» 5 or 6 , characterized in that the central unit 

connected with the position-locating means contains detect- 
ion means which are provided in order to detect from the 
driving direction as determined with the position-locating 

25 means large momentary changes in the driving direction of the 
vehicle and for generating a second correction signal upon 
ascertaining a large momentary change in the driving direct- 
ion, which detection devices are connected with the route- 
determining unit and are provided in order to retrieve 

30 momentary driving route coordinates and to ascertain whether 
these momentary driving route coordinates contain the 
coordinates of a nodal point or a breakpoint and, in 
establishing coordinates of a nodal point or a breakpoint, 
to generate a third correction signal, which transposition 

35 means are operable to determine a correction vector under 
control of a received third correction signal. 
8« Navigation system as claimed in any one of the 
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Claims 2, 3, h t 5, 6 or 7, characterized in that the correct- 
ion unit contains an operator generator for generating from 
the measured speed and lateral acceleration of the vehicle 
and from the generated vehicle position coordinates an acce- 

5 leration operator, which correction unit further contains 

an operation unit which has a first input connected with the 
selection unit for receiving the selected correction vector 
and a second input connected with the operator generator 
for receiving the acceleration operator and a third input 

10 connected with the control unit for receiving a fourth 
correction signal, which operation unit is provided for 
causing the acceleration operator to operate on the select- 
ed correction vector under control of the fourth correction 
signal and for generating therefrom a correction value for 

15 measured acceleration. 

9. Navigation system as claimed in Claim 8, character- 

ized in that the operation unit has an output connected with 
the position-locating means for delivering the correction 
value to the position-locating means which are provided in 

20 order to take up the presented correction value in the 
measured lateral acceleration. 

10* Navigation system in accordance with any one of the 

preceding Claims, characterized in that the central unit 
contains a non volatile memory element which contains a 
25 control input for receiving an enabling pulse generated 

upon the stopping of the vehicle and which non-volatile me- 
mory is provided for storing the last-generated vehicle 
position coordinates under control of the enabling pulse 
and for preserving these vehicle position coordinates when 

30 the vehicle is stationary. 

11. A navigation system as claimed in Claim 8 or 9* cha- 

racterized in that the navigation system comprises a re- 
ceiving unit connected to the communication line for re- 
ceiving position coordinate signals originating from a navi- 

35 gation satellite, and that the control unit comprises a 

mixing unit connected to the communication line for mixing, 
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under the control of a mixing signal generated by the con- 
trol unit, set of generated vehicle position coordinates 
with position coordinates received from the navigation sa- 
tellite, which last-mentioned generated vehicle position 
coordinates and received position coordinates relate to 
the same position, the mixing unit comprising a Kalman 
filter for realizing the said mixing, the said mixing unit 
being connected to the correction unit for receiving the 
correction value and/or the correction vector* 
12. A vehicle comprising a navigation system as claimed 

in any of the preceding Claims. 
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